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Implementation of a Battery Health Monitor and Vertical Lift Aircraft 
Testbed for the Application of an Electrochemistry-based 
State of Charge Estimator 


Abstract - Prediction methods concerning remaining charge in lithium-ion batteries that power 
Unmanned Aerial Vehicles (UAVs) are of critical concern for the safe fulfillment of mission 
objectives. In recent years, lithium-ion batteries have been the power source for both fixed wing 
and vertical lift electric UAVs. The purpose of this document is to describe in detail the 
implementation of a battery health monitor for estimating the state of charge of a lithium-ion 
battery and a lithium-ion polymer battery used to power a vertical lift aircraft test-bed. It will be 
demonstrated that an electro-chemistry based state of charge estimator effectively tracks battery 
discharge characteristics and may be employed as a useful tool in monitoring battery health. 


1. Introduction 


Battery state of charge estimation is an area of research that is having its merits continually 
expanded as eco-friendly systems such as electric and hybrid land, air and sea vehicles continue 
to gain popularity. Such systems, for the sake of maximizing the utility of the system with respect 
to battery usage, call for state of charge estimation to be incorporated into a battery health monitor 
as a co-principal part of the system design. In this paper, we will detail the implementation of a 
battery health monitor that serves to collect discharge data which is used in processing and 
implementation of an electric vertical lift aircraft test-bed. The choice to use a test-bed that 
replicates a vertical lift aircraft with respect to battery discharge is due to the close match between 
the discharge profile of the test bed and that of the vertical lift aircraft. 

The vertical lift aircraft test-bed consists of several parts as shown in Figure 15 and Figure 19. 
It is comprised of a saw horse with six motors mounted to the sides of the saw horse main beam. 
Each motor has a propeller attached to it. The motors are commanded by electronic speed 
controllers and the speed controllers are commanded by an Arduino Uno (a hobbyist grade 
microcontroller). The motors are powered by a lithium-ion polymer battery that consists of five 
individual lithium-ion polymer cells. The types of motors, propellers, and electronic speed 
controllers are consistent with the ones used in a small to medium size vertical lift aircraft to 
ensure a replication of discharge with the lithium-ion polymer battery. The Arduino controller is 
programmed to command the motors to spin. The on state involves a uniform motor rotational 
speed so a constant discharge of the lithium-ion polymer battery occurs. A constant discharge 
corresponds to the discharge that the vertical lift aircraft would experience if it simply were to 
hover. 

The basic hardware implementation of the battery health monitor consists of an ADC, a current 
sensor, a Beaglebone Black, an opto-isolated modules, a custom made PCB, and an I?C 
cable. This experiment is designed to be performed offline using battery voltage and current 
measurements as estimator input data. The estimated state consist of internal battery charge 
values with known initial values. A connector between the battery and the discharge circuit has a 
current sensor along with voltage measurement. 

The battery health monitor operates at 27 Hz and is powered from an independent 
source. This implies that at 27 Hz, the Beaglebone Black sends a request to sample to the ADC, 
then receives the samples for the current and voltage from the ADC, and stores the samples using 
dynamic memory allocation. The state of charge estimation is performed offline on the gathered 
data using an unscented Kalman filter which incorporates an electrochemistry-based model. The 
unscented Kalman filter was chosen for its efficiency and its ability to track highly nonlinear 
trajectories well as demonstrated with the reentry problem [1]. The electrochemistry based model 


is chosen as it has been developed and successfully demonstrated on multiple platforms [2], [3], 
[4], [5]. 

This paper is organized as follows. Section 2 presents the electrochemistry-based battery 
model. Section 3 describes the unscented Kalman filter used for state of charge estimation. 
Section 4 describes the hardware setup. Results are presented in Section 5 and conclusions are 
drawn in Section 6. An appendix is given to supply additional information to the interested reader 
concerning the derivation of the unscented Kalman filter. 


2. Electrochemistry-based Model 


This section describes an electrochemistry model of the lithium-ion battery. The aspects of 
the electrochemistry model that allow it to capture the nonlinear capacity effects of a lithium-ion 
battery are noted. Finally, the dynamics of a lithium-ion battery during discharge and charge are 
described and the mathematical model is defined. 


2.1 Model Differentiation 


The electrochemistry based models are a part of a set of three well noted battery state of 
charge modeling techniques which also include mathematical based models and electrical models 
[6]. Mathematical models include methods such as regression and artificial neural networks which 
are not derived explicitly on physical mechanisms that take place within the battery during 
discharge. These models instead are fit to training data, which can be a drawback. For instance, 
it would be a very daunting task to gather training data for a neural network that expressed the 
state transition from every possible state given every possible input. Electrical models, unlike 
mathematical models, attempt to capture the chemical processes of the battery. They are known 
as empirical models. Devising an electrical model is done by constructing a circuit with 
components chosen to match battery behavior. These models are typically more computationally 
efficient than electrochemistry-based models but are known to suffer the drawback of not being 
able to capture the nonlinear capacity effects of lithium-ion batteries. Electrochemistry models are 
more accurate than empirical models. However, they come with a high computational cost that 
ranges per the method employed [7]. 

What sets the electrochemistry-based model used in this paper and previously presented in 
[2] apart from other electrochemistry-based models is that it is an ohmic porous-electrode model 
that offers the benefit of being computationally efficient through the usage of a set of ordinary 
differential equations to model the update of the charges at the electrodes. The model has been 
shown to capture the nonlinear capacity effects. Such effects consist of the rate capacity effect 
and the recovery effect [8]. The impact of the rate capacity effect on voltage is described by the 
drop or rise in voltage due to the change in current. The model takes this effect into account with 
the use of an ohmic resistance that causes the voltage to subside at higher currents. 

The impact of the recovery effect on voltage is described as the recovery of voltage during 
periods of rest. This allows, if there is a period of rest, for the battery to recover charge and extend 
the discharge time, where the discharge time does not include the period of rest. The ability of 
the electrochemistry-based model to capture the recovery effect comes with the involvement of 
intra-electrode diffusion in the charge update equations. Diffusion within the electrodes takes 
place between the surface and bulk layers allowing the negative electrode to recover charge and 
increase battery voltage. 


2.2 Electrochemistry Model Outline 


The basic kinetics for the electrochemistry model are derived from the chemical reactions that 
take place at the electrodes and are shown in equations 1 through 4 [2]. Equations 1 and 2 are 
the reactions at the electrodes during a discharge. During discharge, an oxidation reaction takes 


3 


place at the negative electrode resulting in lithium-ions and electrons. The electrons travel from 
the surface of the negative electrode to the surface of the positive electrode leaving the surface 
potential of the negative electrode increased and the surface potential of the positive electrode 
decreased causing them to converge towards the same potential. This means that the voltage 
will decrease as the voltage across the battery is the difference between the negative electrode 
surface potential and the positive electrode surface potential. The lithium-ions travel from the bulk 
of the negative electrode to the bulk of the positive electrode through the electrolyte. A reduction 
reaction occurs at the positive electrode when lithium-ions diffuse into the surface and the 
electrons diffuse into the bulk. The result is the increase in the surface potential at the positive 
electrode which counters the decrease from the initial introduction of the electrons. 


Li,C > C + xLit + xe7 (1) 
Li,_,Co0O, + xLit + xe~ > LiCo0, (2) 


Equations 3 and 4 are the reactions that take place at the electrodes during charge. During 
charge, oxidation occurs at the positive electrode and results in lithium-ions and electrons as 
products. The electrons travel from the surface of the positive electrode to the surface of the 
negative electrode resulting in an increase in the surface potential at the positive electrode and a 
decrease in the surface potential at the negative electrode. The surface potentials diverge during 
charge which increases the voltage. The lithium-ions travel from the bulk of the positive electrode 
to the bulk of the negative electrode through the electrolyte. A reduction reaction takes place at 
the negative electrode when lithium-ions diffuse into the surface and electrons diffuse into the 
bulk. This results in an increase in the surface potential at the negative electrode which counters 
the decrease in potential from the introduction of the electrons that traversed from the positive 
electrode surface. 


C+xLit +xe7~ > Li,C (3) 
LiCoO, > Liy_,Co0, + xLit + xe7 (4) 


To define the electrochemistry-based model, the relevant voltages and how they impact the 
voltage of the battery must be detailed. First, the battery voltage that the model is capturing and 
our system is measuring is seen in Figure 1 [2] to be the difference in potential between the 
surfaces of the negative and positive electrodes. 
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Figure 1: Diagram of Relevant Battery Voltages 
The voltages that factor into the determination of the battery voltage can be stated in relation 


to how they detract from the ideal voltage. This voltage is defined in accordance to Figure 1 as 
the difference between Vy, and Vy, ,. The first set of voltages that detract from the equilibrium 


voltage are known as ohmic voltage drops. The ohmic voltages are comprised of the electrolyte 
ohmic voltage denoted V,, the solid phase ohmic voltage of the positive electrode denoted V,,,, 
and the solid phase ohmic voltage of the negative electrode denoted V,,,. The second set of 
voltages that detract from the equilibrium voltage are known as surface overpotentials and are a 
result of charge transfer resistance and solid electrolyte interface kinetics [2]. The surface 
overpotentials are comprised of a negative electrode surface overpotential denoted V,,, and a 
positive electrode surface overpotential denoted V, , 

Now that the voltages are defined, the state definition, the input, the output, and the relevant 
model variables are defined in equations 5 through 7 [5]. The state vector is defined in equation 
5S and consists of the positive electrode surface chargeq,,, the positive electrode bulk 
charge qp,», the negative electrode bulk charge qy,, the negative electrode surface charge q.n, 
the sum of the ohmic voltage contributions V;, the positive electrode overpotential V,,,, and the 
negative electrode overpotential V,,,. The input vector is defined in equation 6 and consists of the 
discharge current igy,. The output vector is defined in equation 7 and consists of the battery 
voltage V. 


x(t) = | s,p 9b,p Tbh,n Isn Vy Vip Vaan ] (5) 
u(t) = Liapp ] (6) 
yt) =[V] (7) 


The state transition equations for the electrode charges incorporate the discharge current and 
diffusion, as shown in equations 8 through 12 [2]. Inter-electrode electron flow occurs primarily at 
the surface of the electrodes. Hence, the current does not have a direct impact on charge at the 
bulk of the electrodes. Indirectly, the current changes the concentration gradient of lithium-ions 
between the surface and the bulk of the electrodes which impacts diffusion and in turn the charge 
at the bulk of the electrodes. The cumulative charge equations are shown in equations 13 through 
15 [2]. 


dsp = lapp + Qbs,p (8) 
dbp = —4bs,p (9) 
don = —bsn (10) 

dsm = —ltapp + Ibsn (11) 


; 1 12 
9bs,i = p (oii 67) ie 


Ap = Isp t+ Ib,p (13) 
Qn = Isn + Abn (14) 
Amax = Ip + An (15) 


These charge equations are coupled directly with the concentration and lithium mole fraction 
equations shown in equations 16 through 20 [2]. In equations 16 and 17, v refers to volume and 
in equations 16 through 20, the subscript i refers to either electrode. The lithium-ion mole fraction 
for the positive electrode must be at least 0.4 and the lithium-ion mole fraction at the negative 
electrode must be no more than 0.6. If the positive electrode has a mole fraction of lithium less 
than 0.4, lithium cannot be reversibly removed [9]. The mole fractions at the positive electrode 


and negative electrode are complimentary so together they must add up to 1. Hence, the mole 
fraction at the negative electrode must be no greater than 0.6. 


Ob.i 
oy = Bt (16) 
AL 
cg = Bt (17) 
SL 
ae (18) 
‘ Amax 
ip eta (19) 
at qs,i,max 
ji ea Met (20) 
‘ Qb,i,max 


The equations to solve for the cumulative ohmic voltage, the surface overpotentials, and the 
intermediate variables are shown in equations 21 through 29 [2] [5]. In equation 21, U, is the 
reference potential. In equations 21 through 29, R is the universal gas constant, T is the electrode 
temperature, n is the number of electrons transferred in from the chemical reaction in equation 1, 
and F is Faraday’s constant. R, is the cumulative resistance from the ohmic voltages drop, a is 
the symmetry factor, and S; is the area of the electrode. The termst,,,, and t,,, denote time 
constants. Lastly, Aj, are parameters for the Redlich-Kister expansion. The Redlich-Kister 
expansion is used to capture the activity coefficient terms related to excess Gibbs free energy [9]. 
For a more detailed outline of the intermediate variables see [2]. 
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The equation to solve for the battery voltage is shown in equation 30 and the state of charge 
equations are shown in equations 31 and 32 [2]. The nominal state of charge refers to the percent 
of charge left at the negative electrode while the apparent state of charge refers to the percent of 
charge left at the surface of the negative electrode. If the charge at the surface of the negative 
electrode becomes entirely depleted, discharge cannot continue until charge diffuses from the 
bulk of the negative electrode so long as the nominal state of charge has not been entirely 
depleted in that instance. The constants for the electrochemistry-based model are shown in Table 
3. The Redlich-Kister coefficients for the lithium-ion battery are shown in Table 1. The Redlich- 
Kister coefficients for the lithium-ion polymer battery are shown in Table 2. 


V=Vaip — Yun - Wo Viw ~ Vin (30) 
q 
SOC mat = Tmax (31) 
SOC ee (32) 
Seer 0.64s,n,max 


Table 1: Lithium-ion Battery Model Parameters Table 2: Lithium-ion Polymer Battery Model Parameters 


Parameter Value Parameter Value 
Uop 4V Uop 4.16 V 
Ap,o -38246 J/mol Ap,o -17343 J/mol 
Ap,1 -12651 J/mol Ap,1 8523.8 J/mol 
Ap,2 23624 J/mol Ap,2 2953.1 J/mol 
Ap,3 -78405 J/mol Ap,3 -440 J/mol 
Ap,4 1122.5 J/mol Ap,4 -178 J/mol 
Ap,5 321970 J/mol Ap,5 -310 J/mol 
Ap.6 84521 J/mol Ap.6 634 J/mol 
Ap,7 -1075200 J/mol Ap,7 -394 J/mol 
Ap,8 1656 J/mol Ap,8 -1900 J/mol 
Ap,9 989930 J/mol Ap,9 -464 J/mol 
Ap,10 282570 J/mol Ap,10 -511 J/mol 
Ap,11 -161280 J/mol Ap,11 8021.7 J/mol 
Ap,12 -507580 J/mol Ap,12 -9000 J/mol 
Uon 0.01 V Uon 0.01 V 
Ano 86.19 J/mol Ano 86.19 J/mol 
max 15,750 C max 40170 C 
Ro 0.2524 O Ro 0.0045 O 
D 4.6831x10° mol D 4.2157x10® mol 
s/C/m* s/C/m* 
Table 3: Battery Model Constants 
Parameter Value 
R 8.3144 J/mol/K 
T 292.1 K 
F 96487 C/mol 
n 1 
To 2.08671 s 
a 0.5 
Sp 3.0962x10% m2 


kp 248898 Alm? 


Vs,p 2x10* m° 
Vb,p 1.8x10° m° 
Tap 46.4311 s 
Sn 4.3755x10* m? 
Kp 2120.96 A/m? 
Ven 2x10°6 M3 
Vo,n 1.8x10°5 M3 
ane 1001.38 s 


3. Unscented Kalman Filter 


Given the nonlinear model of Section 2.2, a method is needed to estimate the state defined 
in equation 5 given the battery current i,,, and the output voltage measurement V. The 
Unscented Kalman Filter (UKF) is used here for nonlinear state estimation. The equations are 
given below and can be found in reference [1]. Appendix A gives the reader background on the 
UKF. First, the weights w and sigma points y are calculated. Here n,, is the system order, x is a 
tuning constant, <is the mean, and P is the state autocorrelation. The superscript / is the i” 
column. It is very important that the electro-chemistry model be initialized properly for the given 
battery. Table 1, Table 2, and Table 3 give the values used in this implementation. 


Geka (33) 
ny, + K 
i iL es (34) 
w= 2(n, +6)’ l= 1,2, beep Lye 
v= Xe —1)k-1 (35) 


_ ——_i (36) 
x: = Xk-1|k-1 + ( (ny + K)Pe-aje-1) , L= 1,2, wey Ng 
— a (37) 
Xo = Re-aye-1 - ( [rx + KP eater) ; i=n,+1,n, 4+ 2,...,2n, 


The prediction step involves passing the sigma points through the nonlinear system model. 
The state equation is f(-) and the measurement equation is g(-). Both the state and measurement 
equations are determined from the electro-chemical model of Section 2.2. The input u is the 
battery current ig,, and k is the current time step. 


PHP tis). ES b2 con (38) 
yi= 9(”'), i= 1,2,...,n, (39) 
eS . (40) 
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Pra =Q+ > w'(f! — Rater) (2! - Rete) 
i 
The update steps are shown below; n, is the number of sigma points. The notation k|k — 
1 means the current time step k given measurement data up to time k — 1. The update occurs by 
using the new voltage measurement y, = V to update the state estimate. 


ad . , (43) 
Py =R+ » w'(P! — Picea) (P! — Detx—1) 

i 

ae (44) 
Pry =) wi(#! = Reet) (P! = Suet) 
i 

kK, = Ee (45) 
Kalk = Xeje-1 + Kx (ve = Drelk—1) (46) 
Pre = Prete-1 — KePyy Kit (47) 


In the above algorithm, Q is the process noise covariance matrix and R is the measurement 
noise covariance matrix. 


4. Hardware and Software Setup 


The hardware setup is designed to gather data from a lithium-ion battery and lithium-ion 
polymer battery during discharge. The data is post processed by the unscented Kalman filter 
using the electro-chemistry battery model. The first section of the hardware and software setup 
details the hardware used, the hardware connections, and the software control flow for the battery 
health monitor. With the battery health monitor, discharge data can be gathered from a lithium- 
ion battery. The second section of the hardware setup details the construction of the vertical lift 
aircraft testbed, how it is controlled, and how it is interfaced with the battery health monitor to 
gather discharge data from a lithium-ion polymer battery. 


4.1 Battery Health Monitor 

The connections between the battery health monitor components are shown in Figure 2 and 
Figure 3. The primary controller is the Beaglebone Black. The Beaglebone is chosen as the 
microcontroller because it has a 1 GHz Arm cortex A8 processor with a Debian Linux operating 
system, 2x46 pin headers, and a small lightweight frame. The data gathering module is a Linear 
Technology LTC2309 12-bit ADC that has a 5-volt reference voltage. The ADC is powered by a 
5-volt source as opposed to a 3.3-volt source that powers the Beaglebone. This requirement adds 
an extra degree of complexity to the design as the Beaglebone must not only power but interface 
the ADC as well. The ADC I?C pins operate from a 0 to 5-volt range and the Beaglebone |?C pins 
operate from a 0 to 3.3-volt range. The difference in operating voltages between the Beaglebone 
and the ADC presents an inability to communicate over I?C with a direct connection of the SDA, 
SCL, VCC, and GND pins of each device. Communication is achieved between the two devices 
using an Adafruit Bidirectional level shifter. The function of the level shifter is to step-up the SDA 
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and SCL voltages of the Beaglebone from 3.3 volts to 5 volts when the Beaglebone is sending 
data to the ADC and to step-down the SDA and SCL voltages of the ADC from 5 volts to 3.3 volts 
when the ADC is sending data to the Beaglebone. For the data gathering, the ADC takes samples 
of the battery voltage and the discharge current using a 100-amp current sensor. The design 
requirements for this battery health monitor mandate that the current sensor has a 9-volt reference 
voltage. The output of the current sensor is 5 to 0 volts representing 0 to 100 amps and 5 to 10 
volts representing 0 to -100 amps. The reference voltage to the current sensor is provided by a 
Pololu S18V20ALV adjustable step-up/step-down voltage regulator that steps up 5 volts from the 
Beaglebone to 9 volts. To ensure the reference voltage to the ADC remains constant and does 
not vary due to a change in the power source to the Beaglebone, a Pololu D24V22F5 step-down 
voltage regulator is placed between the aforementioned step-up/step-down regulator and the 
ADC to provide a constant 5-volt source to the ADC. For safety and noise reduction purposes, 
input opto-isolated modules are used to isolate the battery and current sensor from the ADC. A 
Dataforth 8B31-02 module is used to isolate the current sensor from the ADC for a current reading 
and a Dataforth 8B31-09 module is used to isolate the battery from the ADC for a voltage reading. 
For convenience, a custom PCB board is used that embeds the input opto-isolated modules, the 
level shifter, and ADC into one unit. The battery tested is a 2200 mAh, 3.7 V nominal, 18650 non- 
protected rechargeable TLIFE lithium-ion battery. 
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Figure 2: Battery health monitor schematic 
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Figure 3: Battery health monitor setup for lithium-ion battery 


Detailing the connections between the Beaglebone and the ADC starts with outlining the I@C 
pins on both. I?C communication requires four lines. They are VDD, GND, and SDA for data 
transmission, and SCL for clock. Using Figure 4 to indicate which pins on the Beaglebone are 
involved in the I?C protocol, we note that pin 52 (DC_3.3V) is used for VDD, pin 50 (GND) is used 
for GND, pin 69 (F-C2_SDA) is used for SDA, and pin 68 (?}C2_SCL) is used for SCL. Figure 5 
indicates which pins on the ADC are involved in the I?C protocol. To bridge the pins involved in 
the I?C protocol on the Beaglebone with the pins involved in the I?C protocol on the ADC, a level 
shifter, a step-down voltage regulator, and a step-up/step-down voltage regulator are used. 
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Figure 5: LTC2309 ADC pin map 


Using Figure 4 through Figure 8, we describe the connections between the Beaglebone, the 
ADC, the level shifter, the step-up/step-down voltage regulator, and the step-down voltage 
regulator as shown in Figure 9. Note that before including the step-up/step-down regulator in the 
circuit, we tuned its voltage adjustment potentiometer to ensure that VOUT was 9 volts. 
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Figure 9: Connection diagram for battery monitor 


The PCB board, with the top level shown in Figure 11, is responsible for routing the 
connections between the level shifter and the ADC along with the connections between the opto- 
isolated modules outputs and the ADC. The PCB board has a header that allows the I?C 
connections from the Beaglebone to be made. The I?C header routes to the level shifter pins. The 
opto-isolated module inputs are routed to headers on the PCB board. A special connector is made 
to fit between the battery and discharge circuit that stems a parallel branch to connect to the PCB 
board header for the Channel 0 opto-isolated module input and has a current sensor that is 
attached on the “hot” line of the connector which outputs a signal to the PCB board header for the 
Channel 1 opto-isolated module input. The current sensor is given a reference voltage of 9 volts 
from the step-up/step-down regulator. Using Figure 7 and Figure 10 as references to the pin 
mappings of the two devices, the connections between the current sensor and the step-up/step- 
down regulator are the following. VOUT from the step-up/step-down maps to the current sensor 
pin denoted 1. GND from the step-up/step-down regulator maps to the middle current sensor pin 
denoted 0. The far right current sensor pin denoted 0 is the output voltage with a level that is 
indicative of the current. The current sensor output voltage and GND map to the PCB board 
header for the Channel 1 opto-isolated module input. The opto-isolated modules serve a few other 
important functions aside from isolating the discharge circuit from the battery health monitor. The 
chief among those functions include ensuring a maximum voltage threshold delivered to the ADC 
and stepping down the input voltage. The 8B31-02 module outputs voltages between 5 and -5 
volts and accepts input between 5 and -5 volts. When the input is greater than 5 volts, the output 
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voltage saturates at 5 volts and when the input is less than -5 volts, the voltage saturates at -5 
volts. As the 8B31-02 is mounted on Channel 1 which is connected to the current sensor, the 
specification of the interaction between the two devices must be clarified. The current sensor can 
output a voltage in the range of 0 to 9 volts. The module saturates at 5 volts. This means with the 
interaction between the current sensor and the module, we lose the ability to track voltages from 
5 to 9 volts. The range of 5 to 9 volts represents -11 to -100 amps with a negative polarity referring 
to a charging condition. These charging conditions should not occur for preserving battery life. 
Therefore, for this application, we neglect the voltage range of 5 to 9 volts from the current sensor. 
This decision gives a benefit of a higher precision in our current measurement. The difference in 
amps represented by two consecutive quantized levels captured by the 12-bit ADC is 0.027 amps. 
The 8B31-09 module outputs voltages between 5 and -5 volts and accepts input between 40 and 
-40 volts. This module is sufficient for mounting on Channel 0 and receiving the voltage of the 
battery from the parallel branch of the connector as the expected voltage of the lithium-ion polymer 
batteries used in the experiment are nominally 18.5 volts. The output to input ratio is 8 which 
implies a step-down factor of 8. The difference in volts represented by two consecutive quantized 
levels captured by the 12 ADC is 0.00977 volts. This means that the voltage measurements are 
more precise than our current measurements. 


Figure 10: Current 
sensor 


Figure 11: Custom PCB board outline 


The control flow of the software starts with the battery health monitor code. The main code is 
written in C for the Beaglebone. The main code is structured to sample the current and voltage 
27 times a second, filter the samples, store the samples using dynamic memory allocation, print 
out the instantaneous samples once a second, and end when the voltage is depressed below a 
lower threshold. The 27 Hz sample rate is accomplished through polling the time until the time is 
equal to or is after the ideal sampling time. When this condition is satisfied, the samples are taken 
and the ideal sampling time becomes the last ideal sampling time plus the sampling period. The 
ideal sampling times are independent of whether the previous samples were taken precisely at 
the ideal sampling times. This method ensures the average sampling period converges to 
0.037037 seconds (27Hz). For instance, if the program samples half a period after the ideal 
sampling period, the next iteration will ideally sample a half a period after the previous sample 
was taken. This allows the shorter sampling period to cancel out with the previous elongated 
sampling period and average with the previous sampling periods to result in approximately the 
ideal sample period. The sampling itself is done through the VoltageRead and CurrentRead 
functions written in C language. It is important to mention the programmatic format of the 
functions. In the VoltageRead and CurrentRead functions, the read ADC function is called twice. 
When the ADC is referenced through the read ADC function the first time, the previous sample is 
returned and the ADC is told to sample the address specific channel. When the ADC is referenced 
through the read ADC function the second time, the sample that the previous read ADC function 
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initiated is returned. This is the sample that is returned by the VoltageRead and CurrentRead 
functions. The address used in the VoltageRead function to reference Channel 0 is 0x88 and the 
address used in the CurrentRead function to reference Channel 1 is OxC8 [10]. The filtering of the 
samples is done with a basic 1 pole infinite impulse Butterworth filter. The filter has a -3dB cutoff 
frequency of 3Hz and is designed for a sampling rate of 27 Hz. The frequency response is shown 
in Figure 12 and Figure 13. 
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Figure 12: Magnitude Response of Filter Figure 13: Magnitude Response (dB) of Filter 


To achieve the function of storing the samples using dynamic memory allocation, two linked 
lists are incorporated: one for the voltages and one for the currents. These lists are singly-linked 
and consist of several nodes that point to each other. Each node consists of a pointer to the next 
node and a value of type double. Each linked list consists of a first node called root, a final node 
called tail, and a size value of type int. A global node is declared but not initialized so that it can 
be used as a ‘null’ value to signal the end of the list. This global value is never altered. To add a 
value to the list, the addNode function is called. This function takes in parameters for the linked 
list, which includes the value to be added to this list. When entering this function, the size of the 
list is checked to be 0 or 1. If the size is 0, the root node is allocated in memory, set to hold the 
value given in the parameters, and set to point to the null node. If the size is 1, a new node is 
declared and allocated in memory to hold the value given with the parameters. It is also set to 
point to the null node. The root node is set to point to this new node and the tail node is set to 
equal this new node. If the size of the list is neither 0 nor 1, the list must have at least two nodes. 
This case requires a new node to be allocated in memory and initialized in the same way the 
previous case does. The differences are that the root node does not need to be altered while the 
tail node does. The tail node is set to point to the node that was just created. It is then set to equal 
this new node. The size of the list is incremented by 1 every time this function is called. 

The printFile function is called to print the lists to a file. This function takes in a voltages linked 
list and a currents linked list. Two nodes are created but not allocated in memory: one is set to 
equal the root node of the voltages list, and the other is set to equal the root node of the currents 
list. These are used so that the list can be iterated through without changing any node values. To 
start the algorithm in this function, the size of the lists must be at least 1. A while loop is used to 
ensure that the two new nodes are not pointing to the null node (since the lists must have the 
same size, only one of the lists needs to be checked). Inside this loop, both values of the nodes 
are printed to the file. The nodes are then set to equal what they each are pointing to. In other 
words, the nodes become the next nodes in the lists. Once the nodes are pointing to the null 
node, the while loop terminates. However, the values of the final nodes have not yet been printed. 
Thus, these values are printed to the file outside of the while loop. After every five voltage and 
current values, the function prints to a new line of the file. For every loop iteration of the code, the 
addNode function is called twice: once for the instant voltage and once for the instant current. 
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The function of printing out the voltage and current once every second is accomplished by keeping 
track of a counter, incrementing it every iteration, printing out the voltage and current when the 
counter reaches 27, and setting the counter back to 1. These instant voltages are used to stop 
the main loop when the voltage decreases below a lower threshold. The printFile function is called 
outside of the main loop to print the voltages and currents to a file just before the program 
terminates. 

The data file is then transferred from the Beaglebone for offline processing which consists of 
fitting the electrochemistry-based model and running the unscented Kalman filter with the data. 
The fitting of data is performed with the Nelder-Mead search algorithm. The Nelder-Mead 
algorithm is a simplex method that searches for input values of a function that result in a local 
minimum of the function [11]. The function minimized using the search algorithm is the square 
difference between the electrochemistry-based model and discharge data. The unscented 
Kalman filter that is used to process the captured data is a part of the PrognosticsAlgorithm library 
and the electrochemistry-based model is a part of the PrognosticsModel library [12] [13]. To allow 
for an overloaded Battery.Create function a constructor for Parameters is made that allows the 
maximum charge, cumulative ohmic resistance, diffusion coefficient, and Redlich-Kister 
coefficients as inputs and adjusts the default parameters accordingly. The sample rate in 
Parameters is also adjusted to have a default value of 0.037037 seconds (27 Hz) for sampleTime. 
The unscented Kalman filter is then used with the parameters found from the Nelder-Mead 
algorithm. 


4.2 Vertical Lift Aircraft Testbed 


The vertical lift aircraft testbed is designed to be used with a lithium-ion polymer battery to 
replicate the discharge of the battery on a hexacopter. The testbed setup consists of three distinct 
systems: the testbed, the testbed controller, and the battery health monitor. A saw pony (small 
saw horse) is chosen as the testbed since it has a body that it is long enough to have 3 motors 
mounted on each side and gives enough space between the motors to allow for non-interfering 
operation when the propellers are attached. The motors are mounted on the base of the saw pony 
with three on each side. The motors are KDE-Direct 4215XF-465 three phase brushless motors. 
They are used in the hexacopter shown in Figure 14 and are designed for heavy-lift electric multi- 
rotor applications. After the motors are mounted, electronic speed controllers are connected to 
the three phase connections of the motors. The electronic speed controllers are KDE-Direct XF- 
UAS 55HVC. They can supply 55+ amps to the motors and can operate at high voltages. The 
ESCs have three wires that are outputs to the three phase motors, three wires that are inputs 
which take in a PWM signal, and two leads that connect to the battery. The leads on all the ESCs 
are soldered together and attached to a connector to the battery. The battery is a Thunder Power 
RC ProLite+Power 25C 7800 mAh 5-cell/5s 18.5V LiPo battery. The wires between the electronic 
speed controllers and the motors are tied down on the saw pony using zip ties to ensure they do 
not interfere with the propellers. The three wires on the ESCs that are dedicated to PWM signals 
are connected to three wire extension cables that are connected to the controller. The ESCs are 
programmable and have been assigned a range of PWM values between 1100 and 1900 
microseconds to represent minimum and maximum motor speed. For debugging purposes, when 
the battery is connected to the ESCs, they beep periodically. The ESCs stop beeping once they 
are supplied with a PWM value. For safety reasons, the initial PWM value supplied to the ESCs 
should be less than the minimum PWM value required to start the motors. The propellers used 
are KDE-Direct CF155-TP propeller blades and are 15.5 inches in diameter and a pitch of 5.3 
inches. The constructed testbed is shown in Figure 15. 
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Figure 15: Saw pony hexacopter testbed 


The controller for the saw pony testbed is implemented with an Arduino Uno. The hardware 
setup of the controller also involves a switch, a resistor, and an Xbee-Pro 900 DigiMesh RF 
Module. The connection between the switch, resistor, and Arduino are described as follows. The 
bottom pin of the switch is attached to a pull-up resistor which connects to pin 7 of the Arduino. 
The bottom pin of the switch also connects to pin AO of the Arduino. The top pin of the switch 
connects to GND of the Arduino. Pin 7 of the Arduino is set to high. When the switch is open, AO 
is read as a high value and when the switch is closed, AO is read as a low value. The connection 
between the Arduino and the Xbee module is the following. Pin 2, which is assigned to be Tx in 
the controller software of the Arduino, is attached to the Dout pin of the Xbee. Pin 12, which is 
assigned to be Rx in the controller software of the Arduino, is attached to the Din pin of the Xbee. 
The 3.3V pin of the Arduino is attached to the Vcc pin of the Xbee and the GND pin of the Arduino 
is attached to the GND pin of the Xbee. The interface to the PWM cables of ESCs from the Arduino 
is built through extending wires from the pins of the Arduino to connectors. The connectors have 
3 holes for pins crimped onto wire to be inserted. They are for GND, Vcc, and Sig wires. The 
connections from the Arduino are the following. The GND pin of the Arduino is connected to a 
wire that branches off into six wires which are crimped with male pins and inserted into the GND 
slot in all the connectors. The 5V pin of the Arduino is connected to a wire that branches off into 
six wires as well which are crimped with male pins and inserted into the Vcc slot in all the 
connectors. Pins 3, 5, 6, 9, 10, and 11 of the Arduino all connect to wires that are crimped with 
male pins and inserted into the Sig slot in the connectors. The interconnections for the controller 
are shown in Figure 16. 
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Figure 16: Arduino Uno saw pony controller schematic 


The controller software can be described by a Moore state machine. The two states are Go 
and Stop with the default state being Stop. The output of the Stop state is a PWM value of 800 
microseconds being sent to the motor ESCs. This is the output in the Stop state as it is intended 
to suppress the ESC beeping through providing a PWM value that is recognized by the ESCs but 
is not high enough to cause the motors to spin. The output of the Go state is a PWM value that is 
higher than 1100 microseconds to cause the motors to spin. A transition occurs every 500 
milliseconds based on serial input and the value of the switch. The guard condition for a transition 
from the Stop state to the Go state is that the sampled value of AO must be above 120, which 
means the switch is open, and the serial input must be a ‘g’. If this condition is not satisfied, the 
Stop state transitions back to itself. The guard condition from the Go state to the Stop state is that 
the sampled value of AO must be below 120, which means the switch is closed, or the serial input 
must be a ‘s’. If this condition is not satisfied, the Go state transitions back to itself. 
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Figure 17: Saw pony testbed block diagram 


The block diagram of the test setup is shown in Figure 17. A computer is used to communicate 
with the Beaglebone through an Ethernet connection. The PC controls the Beaglebone through a 
SSH connection. While running the battery health monitor code, the SSH terminal displays the 
voltage and current every second to give the user an idea of how close the battery is to crossing 
the lower voltage threshold and closing the program. The Beaglebone receives voltages and 
currents from the battery through a custom PCB Analog Interface Board via the ADC. Since the 
Analog Interface Board and ADC can only take in voltages, the current sensor converts the current 
into a voltage between 0 and 9 volts. The Analog Interface Board has two Dataforth Modules, 
which convert higher voltages (above 5 volts) to lower voltages within the ADC sample range. 
The ADC converts this analog voltage to a digital voltage and sends it back to the Analog Interface 
Board through an I?C connection. The Analog Interface Board sends this data to the Beaglebone 
through a separate I?C port. The current is translated from a voltage reading into an Ampere 
reading in the battery health monitor code using calibration data. Both the Analog Interface Board 
and the ADC receive power through the Beaglebone, which receives its power from a 120-volt 
AC source. 

The computer is also used to send signals from an Xbee connected through USB to another 
Xbee connected to the Arduino through UART. Commands are sent through a serial terminal. The 
Arduino sends a PWM signal to the motors on the saw pony, which is used to turn the motors on 
and off. These motors are powered by the battery. The PC controls this signal through a serial 
terminal. The Arduino receives power from a separate 120-volt AC source. The Arduino does not 
directly communicate to the Beaglebone which means when the battery health monitor code stops 
running, the Arduino is not prompted by the Beaglebone to turn off the motors. This is an open 
loop system which means that the user is required to provide input to the system to turn off the 
motors when it is noticed that the battery health monitor code has finished or the battery voltage 
has depleted below a set level. 
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Figure 21: Arduino controller connection to saw 
pony testbed 


Figure 19: Saw pony testbed with Arduino 
controller and battery health monitor 


Figure 23: Observation chamber 
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Figure 20: Battery health monitor connection to 
saw pony testbed 
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The saw pony, saw pony controller, and battery health monitor are placed in a test chamber 
shown in Figure 18 through Figure 21 [14]. The operation of the saw pony testbed is shown in 
Figure 22. The computer is placed in an observation chamber shown in Figure 23. An EM wave 
relay is connected between the test chamber and the observation chamber that can receive an 
EM signal on one side of the relay and emitting the EM signal on the other side of the relay. This 
allows the Xbee in the test chamber that is connected to the Arduino to receive data from the 
Xbee in the observation chamber that is connected to the computer and vice versa. An Ethernet 
cable is routed between the test chamber and the observation chamber. This allows for the SSH 
connection between the Beaglebone and the computer. For extra feedback to the user, an AV 
cable was routed between the test chamber and the observation chamber. In the test chamber, a 
camera is mounted to a stand that is facing towards the saw pony and is connected to one side 
of the video feed cable. In the observation chamber, the other side of the video feed is connected 
to a monitor and displays the video that the camera is capturing. Once the test has finished, the 
data is transferred from the Beaglebone for offline processing which is detailed in the Battery 
Health Monitor subsection. 


5. Results 


This section presents the gathered discharge data and the analysis results using the battery 
health monitor data. The first discharge data set is collected by having a 1 ohm resistor load 
connected to the lithium-ion battery. The data is filtered with the MATLAB smooth function. The 
filtered data is then used with the Nelder-Mead search algorithm to find a set of parameters for 
the electrochemistry-based model that provides a reasonable fit to the filtered data. The 
comparison between the filtered data and the electrochemistry-based model that uses the 
parameters in Table 1 and Table 3 is displayed in Figure 24. 
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Figure 24: Electrochemistry model fit compared to lithium-ion battery discharge 


The first discharge data set is then used for offline processing with the unscented 
Kalman filter. Figure 25 and Figure 26 show the raw data for the voltage and current 
measurements taken using the Beaglebone. It should be noted that the raw data has 
been put through the infinite impulse response filter implemented on the Beaglebone. 
The voltage output of the unscented Kalman filter is displayed in Figure 27. The nominal 
and apparent state of charge calculations using the updated state estimate of the 
charges are displayed in Figure 28. As an indication of correct function, the state of 
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charge is shown to converge to depletion at the same time the voltage approaches its 
knee. 


Measured Voltage Measured Current 
44 3.5 
424 3.0 4 
“| * OPERATOR 
_ 384 os 
2 2 204 
3 se] E 
® = 15 
8 344 ® 
i] 5 
1.0 4 
> 324 (s) 0 
3.0 4 0.5 
284 0.0 4 
26 T T r r r r r r T T r r T T 
9) 500 1000 1500 2000 2500 3000 3500 0 500 1000 1500 2000 2500 3000 3500 
Time (seconds) Time (seconds) 
—— Measured Voltage ——— Measured Current 
Figure 25: Lithium-ion battery constant discharge Figure 26: Lithium-ion battery constant discharge 
measured voltage measured current 
UKF Estimated Voltage UKF State of Charge 
44 12 
42 
104 
40 
a 38 + g 084 
s 2 
= 364 (s) 
co] S O64 
S 344 2 
°o = 
ao ® o44 
3.04 0.2 4 
28 + 
} ws a 7 a 0.0 + . + . r r 
a Cy) 500 1000 1500 2000 2500 3000 3500 0 500 1000 1500 2000 2500 3000 3500 
Time (seconds) Time (seconds) 
— SOC Apparent 
—— UKFEstimated Voltage | ee SOC Nominal 
Figure 27: Lithium-ion battery constant discharge Figure 28: Lithium-ion battery constant discharge 
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The second set of discharge data is collected under the same setup using the 1 ohm resistor. 
The difference in the discharge from the first scenario is that the battery is sporadically 
disconnected from the resistor to provide an intermittent discharge. The raw data for the voltage 
and current measurements is shown in Figure 29 and Figure 30. The output of the unscented 
Kalman filter for the voltage is shown in Figure 31. The nominal and apparent state of charge 
calculations using the updated state estimate of the charges are displayed in Figure 32. As with 
the first data set, the fact that the state of charge is shown to converge to depletion at the same 
time the voltage approaches its knee is an indication of correct function. 
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Figure 29: Lithium-ion battery intermittent 
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Figure 30: Lithium-ion battery intermittent 
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Figure 32: Lithium-ion battery intermittent 
discharge UKF state of charge estimation 


Figure 31: Lithium-ion battery intermittent 
discharge UKF estimated voltage 


The third discharge data set is collected by having the saw pony testbed connected to the 
lithium-ion polymer battery. The lithium-ion polymer battery consists of 5 lithium-ion polymer 
battery cells so the assumption is that the cells are equivalent in voltage and the voltage data is 
divided by 5. The division by 5 is done to compare the voltage of one cell to the electrochemistry- 
based model as the electrochemistry-based model is designed for a single cell. The data is then 
filtered with the MATLAB smooth function. The filtered data is used with the Nelder-Mead search 
algorithm to find a set of parameters for the electrochemistry-based model that provides a 
reasonable fit to the filtered data. The comparison between the filtered data for a single cell and 
the electrochemistry-based model that uses the parameters in Table 2 and Table 3 is displayed 
in Figure 33. 
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Figure 33: Electrochemistry model fit compared to lithium-ion polymer battery discharge 


The third discharge data set is then used for offline processing with the unscented 
Kalman filter. Figure 34 and Figure 35 show the raw data for the voltage and current 
measurements using the Beaglebone. It should be noted that the raw data has been put 
through the infinite impulse response filter implemented on the Beaglebone. The output 
of the unscented Kalman filter is produced by dividing the raw voltage measurements by 
5 to use as input for the unscented Kalman filter and multiplying the output by 5 to get 
the estimated voltage for the entire 5 cell battery. The estimate for the battery voltage is 
displayed in Figure 36. The nominal and apparent state of charge calculations using the 
updated state estimate of the charges are displayed in Figure 37. The convergence of 
the state of charge to depletion at the same time the voltage approaches its knee 
indicates correct function. 
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6. Conclusion 


As the progression of Lithium-ion battery modeling and state of charge estimation takes place, 
it is important to be able to convert these methods into tractable algorithms that can be realized 
in real-time closed loop systems to help ensure the safe fulfillment of mission objectives. With that 
in mind, the impact of this work is two-fold. First, the unscented Kalman filter was shown to 
correctly estimate the state of charge from the data gathered by the battery health monitor. 
Second, the vertical lift aircraft testbed was shown to power vertical lift components used in a 
hexacopter from a lithium-ion polymer battery that is used in the hexacopter. 

The ability of the unscented Kalman filter to track state of charge using data gathered by the 
battery health monitor is important for the following reasons. The first reason is that the 
implementation of the battery health monitor contributes towards the hardware framework of an 
online implementation of the electrochemistry-based state of charge estimation algorithm. The 
success of fitting the model used in the UKF to the lithium-ion battery demonstrates its validity 
and can be compared to model fits in past literature [2]. The second reason was that the model 
could fit the lithium-ion polymer battery data and estimate its state of charge. This shows that it is 
valid to assume that the cells in the battery are in equivalent states. The last reason is that the 
battery health monitor can be used as a hardware framework for a future online implementation 
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of the unscented Kalman filter. The primary benefit the testbed serves is to gather discharge data 
from a battery that is used in a vertical lift aircraft without needing to take on the risks of flying. 

In conclusion, state of charge estimation is demonstrated in the results section to estimate the 
state of charge effectively with respect to observations. First, the state of charge approaches 0 
when the battery voltage begins to drop off. Second, the shape of the state of charge curve is 
correct as the state of charge curve should be linear since the discharge current is constant. Also, 
as expected the apparent state of charge is always less than or equal to the nominal state of 
charge. Finally, the charge state estimates are noise filtered. This can be inferred from noise 
being eradicated from the UKF estimated voltage curve as the estimated voltage is calculated 
using the charge state estimates. 


References 


[1] S.J. Julier and J. K. Uhlmann, "A new extension of the kalman filter to nonlinear systems," in 
AeroSense: The 11th International Symposium on Aerospace/Defence Sensing, Simulation and 
Controls, 1997. 


[2] M. Daigle and C. S. Kulkarni, "Electrochemistry-based Battery Modeling for Prognostics," in Annual 
Conference of the Prognostics and Health Management Society, New Orleans, LA, 2013. 


[3] M. Daigle and C. S. Kulkarni, "A Battery Health Montoring Framework for Planetary Rovers," in 
Aerospace Conference, 2014. 


[4] B. Bole, C. S. Kulkarni and M. Daigle, "Adaptation of an Electrochemisty-based Li-ion Battery Model 
to Account for Deteriorization Observed under Randomized Use," in Annual Conference of the 
Prognostics and Health Management Society, 2014. 


[5] M. Daigle, "End-of-discharge and End-of-life Prediction in Lithium-ion Batteries with 
Electrochemistry-based Aging Models," in American Institute of Aeronautics and Astronautics, San 
Diego, 2016. 


[6] A. Seaman, T.-s. Dao and J. McPhee, "A Survey of Mathematics-based Equivalent-circuit and 
Electrochemical Battery Models for Hybrid and Electric Vehicle Simulation," Journal of Power 
Sources, vol. 256, pp. 410-423, 2014. 


[7] V. Ramadesigan, P. Northrop, S. De, S. Santhanagopalan, R. Braatz and V. Subramanian, "Modeling 
and Simulation of Lithium-ion Batteries from a Systems Engineering Perspective," Journal of the 
Electrochemical Society, vol. 159, no. 3, pp. R31-R45, 2012. 


[8] T. Kim and W. Qaio, "A Hybrid Battery Model Capable of Capturing Dynamic Circuit Characteristics 
and Nonlinear Capacity Effects," /EEE Transactions on Energy Conversion, vol. 26, no. 4, pp. 1172- 
1180, 2011. 


[9] D. Karthikeyan, G. Sikha and R. White, "Thermodynamic Model Development for Lithium 
Intercalation Electrodes," Journal of Power Sources, vol. 185, no. 2, pp. 1398-1407, 2008. 


27 


[10] Linear Technologies Corporation, "LTC2309 - 8-Channel, 12-Bit SAR ADC with I2C Interface," 2008. 
[Online]. Available: http://cds.linear.com/docs/en/datasheet/2309fd.pdf. [Accessed November 
2016]. 


[11] J. Mathews and K. Fink, "Numerical Optimization," in Numerical Methods Using Matlab, 4th 
Edition, Upper Saddle River, Prentice Hall, Inc, 2008, pp. 430-436. 


[12] M. Daigle, "Prognostics Algorithm Library [Computer Software]," 2016. [Online]. Available: 
https://github.com/nasa/PrognosticsAlgorithmLibrary. [Accessed November 2016]. 


[13] M. Daigle, "Prognostics Model Library," 2016. [Online]. Available: 
https://github.com/nasa/PrognosticsModelLibrary. [Accessed November 2016]. 


[14] J. J. Ely, S. V. Koppen, T. X. Nguyen, K. L. Dudley, G. N. Szatkowski, C. C. Quach, S. L. Vazquez, J. J. 
Mielnik, E. F. Hogge, B. L. Hill and T. H. Strom, "Radiated Emissions from a Remote-Controlled 
Airplane-Measured in a Reverberation Chamber," NASA, Hampton, 2011. 


[15] S. Sarkka, Bayesian Filtering and Smoothing, New York: Cambridge University Press, 2013. 


28 


Appendix A 

The purpose of this appendix is to give the reader a sense of the development of the Unscented 
Kalman Filter, UKF. Presented here is the basic general Gaussian filter with descriptions of both 
quadrature and cubature integration used in implementing the UKF [15]. While the provided 
explanations do not serve as mathematical proofs, they do give the reader a sense for how the various 
methods were developed along with applications. 


The system model is assumed to be nonlinear and Markovian. Here we have that 
X~ = fpr) + Ie-1 
Ve = A(Xp-1) + Te 


where qx_; and r;, are independent Gaussian noise. The variable k is the time step and f(-) and h(-) are 
nonlinear transforms. The measurement at k is y; and the n dimensional state to be estimated is xX,. It is 
the goal of the Bayesian filter to return state estimates given past output measures. The state and 
measurement probability density functions may be expressed as 


Xp ~ P(X |Xp-1) 
Ve ~ PVR IXK) 


The Bayesian filter estimates the state density given all past measurements up to k; that is 
estimate p(Xx|V1.%). Per Bayes’ rule, we may write the probability density function conditioned on 
V4:k—-1 as follows 


PV Xk Vi:k—1)P Xr |V1:e-1) 


(x , 1K )= 
P(XkIV ke Vak-1 PV K|V1:K-1) 


Because of the Markovian assumption and application of the Chapman-Kolmogorov equation to the 
denominator, we may write 


p(<el¥ux) = PVE IX IP KI 1:K-1) 
KIVise) =" pA. as Naf 1 
/ S pO)? elk 1) XK 


The above expression may be used in the Bayesian filter algorithm. The filter consists of three basic 
steps: initialization, prediction, and update. We start with some initial estimate of the state density to be 
estimated p(x). Given measurements up to and including time step k-1, we can predict state x, before 
measurement y; with the Chapman-Kolmogorov equation 


P(Xxk|¥1:k-1) = | D(X |Xe-1)P K-21 V1:k—-1AXK-1 
To update the estimate at time step k, we use the measurement y, and Bayes rule to 


evaluate p(x, |V1.,). In general, a closed form solution does not exist for the Bayesian filter. However, if 
both f(-) and h(-) are linear functions, the Kalman filter may be used. 
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To use the Bayesian filter for nonlinear state estimation, some assumptions and approximations must be 
made. First, we assume that the system output of the nonlinear transform is approximately Gaussian. In 
general, this is not the case; but the Gaussian approximation may provide a close enough fit to meet 
filtering requirements. There is also a need to solve integrals in real time that in general do not have 
closed form solutions. To do this, numerical solutions are used to approximate the integral. To lay out 
the filter algorithm, consider the following matrix relation for Gaussian random variables: x~N(x|, P) 
where x is a Gaussian vector with mean and covariance matrix P. The vector x can be partitioned into 
two sections. 


«=Gsl e= tel o= EF a 
The conditional probabilities of the joint random variables x, and x, are given by 
P(xalxp) = N(Xal Ha + PeP5 (Xp — My), Pa — PeP5 Pe) 
DOG |e.) = NG | ig! Py Oy iy), Pp Pes PD) 


The above identity may be used to determine the Bayesian filter algorithm through moment matching. 
We can define the joint probability density function for x, and y, and next determine the conditional 
density of x; given the new measure y; has occurred in the update step. Using the templet above to 
stage our construction, we have the following. 


= phe _ He Pe 2] 
D(X Ve) = N(x|H, P) x=[)*| y= |" a Ce USE 


P(XK | Ye) = N(xx|Mx , Pre) 
My = me + CySe (Ye — He) Pe = Pe — Ce Sg Ch 


The algorithm is shown below for the case of additive noise and nonlinear system model f (-) and 
measurement model h(:). 


Algorithm for General Gaussian Filter 


Prediction: We first need to predict the mean and covariance of the state x, before a measurement 
occurs. We do this by using the state model along with our best estimate of the density function, 
assumed to be Gaussian. Of the mean and covariance, we have 


My = | Fe NG abe a Pevdde-s 


Pz = i Ef (ya) — mz} Lf Oren) — MZ} N Gea lity Pea Exn1 + Qeaa 


Update: To update our estimate of the state x, given the recent measurement y;, we use the 
conditional density relationship p(x, | yx) as derived above using moment matching as well as the 
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definitions of mean and covariance for a random variable given its probability density function. We 
assume a Gaussian distribution. Although in general the output of a nonlinear system given a Gaussian 
input is not Gaussian, we make this assumption as an approximation to design a filter realizable in real 
time. 


UE = [ neon cee my , Pe dx, 
Sk = [ee — Ugh {h(xK) = Mid Ny | me» Pye) dXp-1 + Re 


Cy = [x — mz) {h(x — UN (xK| me, Pye) dxX~-1 + Re 


With solutions to the above integrals, we can finish the recursion using the results from moment 
matching. 


my = me + CySe* (Ye — He) Pe = Pe — Ce Sg Ch 


In general, closed form solutions to the integrals are not possible. Numerical integration techniques are 
used to approximate the integrals for real time implementation. Two techniques are considered here: 
Gauss-Hermite and Spherical cubature. 


For Gauss-Hermite integration, consider the definition of the mean given that x is a Gaussian random 
vector and g(-) is some transform. 


| g(x)N(x|m, P)dx = | g(x)exp {= —m)’P V(x - m)} dx 
| (2m)"/2|P|'/2 2 


To use Gauss-Hermite integration, we must use a change of variables to make the distribution zero 


mean and unit covariance. Let x = m + VPé and recalling that we must take the determinant of the 
Jacobean for multivariable change of variables we have 


saranda VPé)exp {= (m4 VPE —m) P-1(m + VPé -m) |VP|dé 


Since the covariance matrix is positive semi-definite, we have |vP| =|P| /2. \Ne now have the desired 
form. 


[ sconce, Pax =| a(m + VPE)N(E|0, dé 


One way to approximate this integral is to use Hermite polynomials. This approximation comes from the 
mathematics and physics communities and is simply stated here without derivation. 


[ sconce, P)dx od >. Wi,,...ing(m + VP EUn-in)) 


The sigma points € are the roots of the pr order Hermite polynomial and the weights W are given by 


! ! 
er eee oon x ee 
p?{Hp-1"} p?{Hp—1"} 


ig,tn 


Since this integration method takes an n dimensional integral and breaks it down to n one dimensional 
integrals, the number of sigma points grows on order p”. 


To reduce the computational burden of numerical iteration, spherical cubature integration is used. The 
algorithm is presented here without development. 


Consider the 2n-point approximation to the multi-dimensional Gaussian integral 


2n 
[ s@e lo, nag ~ wD’ g(cu') 
i=1 


Here W and c are scalar constants to be determined. There are 2n symmetric vectors, each of length n. 
As an example, consider the case for n = 3. 


1] sO] JO] J-1 0 0 
u= {uM wu, uw, uu} = 101, |1],/0},] 0 |,]-1],] 0 
O01 LOJ LL 0 0 = 


We can determine the constants W and c by considering two exact solutions; one for g; (€) = 1 and one 
for gj (€) = ae The subscript j here is for the j” element of a given vector from the set of 2n vector set 


u. For the case of g;(§) = 1 we have that 


1 


2n 
[ ong lo,nag = t=w) sw wae 
i=1 


For the case of g;(¢) = &F we have that 


2n 
| due |0,)d§=1= wy {eu} =W2e2 c=vn 
i=1 


For example, consider the case of n = 3 as described above. If we choose the second element, for 
example, we can write 


2n 
nid 1 
w > {eus?} = W{c20? + c712 + c202 + c702 + c2(-1)? + c207} = W2c? = mee c=vn 
i=1 


As we did with Gauss-Hermite integration, we can do a change of variables to generalize the spherical 
cubature integration. 
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2n 
1 F : 
| g(x) N(x|m, P)dx ~ md, g(m+ VP) ¢© = Vnu, 


The approximation above is very like the unscented transform. If we include a zero-vector sigma point 
and an additional parameter for tuning, we can obtain the unscented transform. 


By using either the Gauss-Hermite or spherical cubature integration to solve the integrals of the Kalman 
filter algorithm, one obtains a realizable implementation for nonlinear state estimation. 
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